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ABSTRACT 



With the increased demands for higher productivity in industry’ and the military, 
control of Robot Manipulators with flexible joints is needed. The difficulties associated 
with the control of flexible joint robots include the following: (1) Nonlinearity of the 
arm motion (2) Coupled large motion (motion of the motor) and small motion (me- 
chanical vibration) and (3) measurements of feedback signals. This theis presents an 
controller designed to handle the difficulties related to flexible joint robots. The third 
joint of the PUMA 560 Robot was selected as an example. A control algorithm for 
flexible-body control was devised and an observer was designed with the use of 
MATRIX^ to control tip motion of the single-link single-joint system. Computer simu- 
lation results are discussed, and a comparison between rigid-body controllers and the 
flexible-body control is conducted. 
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I. INTRODUCTION 



A. ROBOT MANIPULATOR USES 

There is an increasing trend within the United States Navy towards applications that 
utilizes robots to perform tasks which are considered routine or dangerous for humans 

to perform. These tasks include: 

1. Under- water research and exploration 

2. Fire fighting 

3. Battle field logistic vehicle 

4. Perimeter patrol 

5. Under-water autonomous vehicle 

Robotic submersibles are being studied and tested to be used to explore areas of the 
oceans that are presently too hazardous for man to explore. There is also a large po- 
tential for the use of robots in space. 

All the applications listed require close-loop automatic control that typically lead 
to manpower reductions, improvements in stability and response. 

In addition, the robotic manipulators currently installed in industiy^ also have the 
potential for improvement in the areas of increase accuracy, performance, as well as 
weight to load capacity and productivity. The enhance performance must come with a 
realized savings in cost and reduction both in energy consumption and overall physical 
plant size. 

B. BACKGROUND 

.Most work in the past have centered on rigid body manipulators until recently when 
flexible body manipulators began to show great potential in industry. 
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Control systems for industrial robots are currently designed using mathematical 
models in which the links and drive trains are assumed to be rigid (Ref. 1: p. 196]. The 
joint positions are controlled independently, using position and velocity feedback from 
sensors located at the joint actuators. 

However, improvements in dynamic response and payload to weight ratio require 
that the flexibility effects be taken into account in the modeling stage and incorporated 
into the controller design. Preliminary results of studies of link structural flexibility 
versus drive train compliance for several industrial robots, indicated that structural 
flexibility accounts for 2 - 20% of total arm compliance. If the structural flexibility of 
the arm is small relative to the drive train flexibility, then the arm could be represented 
by a rigid body model with "compliance lumped between the actuators and links." 
(Ref 1: p. 196] 

Drive train flexibility plays a critical role in robot motion control design. It has been 
shown that closed loop speed response of the manipulator can be increased beyond 
typical industrial practices by considering the drive train compliance in the design and 
providing suitable feedback measurement (Ref 1: p. 197]. Using a lumped parameter 
model, Forrest- Barlach and Babcock (Ref 1; pp. 196-197] studied the effects of drive 
train compliance and actuator dynamics by modeling a two DOF manipulator and de- 
signing a position controller based on inverse dynamics. Simulation of various control- 
lers were performed utilizing the Advance Continuous Simulation Language. Their 
inverse dynamics control law is based on the concept of "computed torque." This 
method decouples the motion of the arm when drive train compliance and actuator dy- 
namics are considered. The "computed torques" concepts are utilized to determine the 
required input torques as functions of jerk rate, jerk, acceleration, velocity and position 
errors. Jerk rate is a fourth ordered term. The ITAE performance criteria for pole 
placement is used to minimize the error between the desired and the actual state 
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measurements [Ref. 1: p. 200]. They concluded that in general after comparative 
simulations, the inverse dynamics controller performance was superior to that of the 
other controllers they tested due to its ability to decouple the arm motion 
(Ref 1: pp. 200-203). 

The simulation study was conducted without considering practical limits on avail- 
able motor torques. Forrest- Barlach and Babcock concluded, limitation in available 
torques will significantly affect system response. Therefore Forrest-Barlach and Babcock 
felt the effect of torque limiting on the relative performance of the controllers should be 
evaluated by selecting appropriate torque limits for the specific motors. 
[Ref 1: pp. 203-204] 

In another study, Marino and Spong [Ref 2: p. 1030] found joint elasticity is the 
dominant source of compliance in most current manipulator designs. This joint flexi- 
bility may arise from gears, belts, links, bearings, and hydraulic lines and limit speed and 
dynamic accuracy achievable by control algorithms designed assuining perfect rigidity 
at the joints. The nonlinear control problem using a single link manipulator with joint 
elasticity were studied. 

In their work, two nonlinear control techniques to control the manipulator: (1) 
feedback linearization design and (2) composite control design were used. It was found 
that feedback linearizing control required full state measurements which in their case 
included the velocities of both the link and the motor shaft. Whenever part of the state 
was not accessible for measurements, problems were created. [Ref 2: pp.1031-1035] 

Based on extensive analytical and experimental studies by Sweet and Good 
[Ref 3: pp. 724-727], realistic robot dynamic models have been presented which has 
been validated over the frequency range from 0 to 50 Hz. These models exhibit a strong 
influence of drive train flexibility, producing lightly damped poles in the neighborhood 
of 8 Hz, 14 Hz, and 40 Hz, all unmodeled by the conventional rigid body multiple link 
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robot dynamic approach. They also noted the significance of drive train and mechanical 
flexibility had been recognized in only a few prior papers. One approach they used to 
improve robot motion control performance was to decouple the dynamics of the robot 
links through nonlinear control. The decoupling action performed by the controller was 
particularly significant in the same frequency range where resonant behavior occurs 
which was present in the robot motion control loop of electro-mechanical drives with 
flexibility in series with the load. Sweet and Good also realized the existence of drive 
train interactions did not dismiss the idea of using nonlinear or decoupling control 
strategies, but it required the use of realistic drive train models in the development of 
usable algorithms. Also they found high gear ratios employed in most drive units causes 
the torques resulting from cross-coupling effects as reflected back to the motors to be 
minimal [Ref 3; pp. 725-726]. 

In a separate design study, Spong [Ref 4 : p. 312] investigated a second method of 
approach to control elastic joint manipulators. The second method is based on the "in- 
tegral manifold formulation" of the equation of motion. One advantage of this approach 
as noted by Spong, is it can be applied when only the link position and velocity are 
available for feedback. Spong concluded at the end of his evaluation that by using 
global feedback linearization, the nonlinearities in the system do not have to be com- 
puted exactly but rather once the proper coordinates are found in which to represent the 
system, the so called matching conditions can be satisfied. In other words the nonline- 
arities are all in the range space of the input. He further realized realistic limitations on 
motor torques can prevent the arm from reaching velocities of sufficient magnitude for 
cross-coupling terms to become significant, but realistic trajectories for robot arms in 
actual manufacturing applications rarely require extremes of velocity and acceleration 
[Ref 4: p. 310]. He finally concluded the integral manifold based corrective control 
method needed further investigation [Ref 4: pp. 314-318]. 
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The objectives of the above work have been the study of the nonlinear control 
problem for a robot manipulator with joint elasticity. Much of the past research in 
robotics modeled the robot manipulator as a rigid joint and did not consider joint 
elasticity. But recent studies have found joint elasticity is the dominant source of com- 
pliance in most current manipulator designs. It was their intention to illustrate several 
nonlinear control techniques to solve this control problem of joint elasticity. Their re- 
search provides the background for the investigation of a computed torque controller 
structure which considers drive train flexibility of a single link manipulator. 

In this work, the computed torque controller will be enhanced and evaluated. The 
"computed torque" concept requires the values of the second and third derivatives. Since 
these values can not be measured from the plant, an observer or estimator will be de- 
signed as part of the controller to provide the estimates of these unmeasurable values. 

C. METHOD 

The flexible manipulator offers low power consumption, ease of transportation, re- 
duced material requirement, lower mounting strength and rigidity requirement, and 
lower overall cost [Ref 5]. To meet the needs of a light-weight manipulator having 
greater performance capabilities, certain problems must be solved in order to fully utilize 
the flexible manipulator. 

The model must adequately describe the system and yet it must be simple enough 
to implement in order to design an adequate controller for the computation purpose. 

The controller in this thesis is designed by using the technique called the inverse 
dynamics control law based on the concept of "computed torque". This control ap- 
proach represents a method of decoupling the arm motion when drive train compliance 
and actuator dynamics are considered. A single revolute joint was modeled for this re- 
search. [Ref 1: pp. 196-197] 
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First the plant will be discussed in Chapter III and the controller design procedure 
will be developed in Chapter IV. The parameters of the third flexible joint of the Puma 
560 Robot was used in the design procedures (Figure 1). A rigid body controller is 
currently installed in the control loop of the Puma 560 robot. A description of the Puma 
560 Robot is found in Appendix B. (Ref 6: p. 1-27J 

The MATRIX;,.! computer software was used for the modeling of the controller and 
the plant and the software was installed on the Vax computer system. MATRIX^ is a 
software package for modeling, simulation, engineering analysis, control design and 
system identification. A description of MATRIX;^ can be found in Appendix A. 



1 ,MATRI.\;f is a trademark of Integrated Systems Incorporated. 
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INNER LINK 




Figure 1. Joint 3 PUMA Robot Ann 
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II. PROBLEM STATEMENT 



A. INTENTIONS 

In the design of robot manipulators, controlling the tip position is of major concern. 
The end effector (robot tool) is attached to the tip position and through it performs the 
function of the robot arm. The second consideration is the small oscillation (small mo- 
tion) between the arm position and the motor position. 

Figure 2 shows a single-link manipulator with joint flexibility, consisting of an 
actuator (DC motor), a transmission line, and a rigid single link. The transmission line 
includes a flexible helical spring coupling and the indicated gears. The transmission 
line's flexibility is the cause of the difference between arm position and motor position. 

It is the intent of this research to design a controller which can accurately control 
the tip position and also account for and minimize the small oscillation (small motion) 
of the system. 

B. PROCEDURE 

This research is conducted in three phases. 

First, using Lagrangian dynamics approach, a mathematical model of the flexible- 
body model plant is derived. Next the flexible-body controller is designed using the 
concept of control law along with designing a state observer. 

Second, considering the special case of rigid-body control, a comparison between the 
two methods of feedback, motor feedback and arm feedback, is conducted with the best 
method of feedback control selected to continue comparison test and analysis. 

Third, after determining that the past method of control could be improved on by 
a flexible-body controller, comparison tests are conducted between the selected 
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Figure 2, Single-Link Manipulator nith Joint Flexibility 
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rigid-body controller and the flexible-body controller. A determination is made at the 
end to show how much the flexible-body controller improves plant operation. 

Flexibility of the gear train will be considered in this research work but gear back- 
lash will be neglected for now. Various simulation runs will be conducted with various 
parameters to study the dynamic flexibility behavior of the control system. An investi- 
gation of the special case of a rigid-body controller controlling a flexible body plant will 
be observed and compared with the simulation results of the fle.xible-body controller. 



10 



III. PLANT MODELING 



A. EQUATIONS FOR PLANT 
1. Flexible Body Model 

Due to its systematic approach, the Lagrangian dynamics approach is used to 
derive the equations of motion. The total kinetic energy is comprised of the individual 
kinetic energies of the link, actuator, and any applied forces. The total potential energy 
of the system is comprised of the elastic strain energy of the link and the potential energy 
due to gravity. Generalized forces are made up of any applied forces and damping 
forces. Through mathematical manipulations and simplifications, two sets of coupled 
non-linear equations are derived. [Ref 7; pp. 239-254] 

Consider a single revolute joint (Figure 2), consisting of an actuator (DC mo- 
tor) whose rotor inertia J„ is connected through a transmission link to a rigid link with 
inertia about the axis of rotation. The transmission line consist of a flexible helical 
spring coupling and the gears shown. The transmission line has a spring with stiffness 
k and the gear ratio is equal to G,. 

^ Angle in Motor Side 
Angle in Arm Side 

The generalized coordinates includes the link angle 6^ and the motor shaft angle d„ . 
The following relationships will apply in the derivation of the plant model; 

— 0^ = S (deflection) (3.1) 

Since the motion of the link is a pure rotation about the motor axis, the kinetic 
and potential energies are: 
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(3.2) 



{KE) = \},dl + 

{PE) = ^k{e,G, - ej + m,g-^{\ - sin0J (3.3) 

Where m, is the total mass of the arm (link) and is the distance from the axis of ro- 
tation to the center of mass of the arm. 

The equations of motion are found from the Lagrangian method to be: 

j A + y cos 9. = 0 (3-'l) 

- *(9.G, - ej= T (3.5) 

Where T is a generalized force applied to the transmission line through the actuator. 
[Ref 7: pp. 259-261] 

See Figure 3 for a block diagram of the Flexible Body model plant. 

2. Rigid Body Model 

For the special case of a rigid body model, the following assumptions are made 

(refer to Equations 3.2 and 3.3) [Ref 2: p. 1030]: 

1. K — ► oo 

2. The elastic displacement 9, — 6„ -+ 0 

Therefore the kinetic and potential energies equations for the rigid body case 
reduces to: 



KE = -|(J, + Jjel 
PE = m„gy(l - sin0J 



(3.6) 
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Figure 3. Flexible Body Model Plant 
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Referring back to Equations (3.3) and (3.4), The Lagrange equations reduces to: 

(J^ + + m^gycos0^ = T (3.7) 

The only nonlinearity term, cos appears in Equations (3.4) and (3.7). 

B. ADDED MASS AND DAMPING 

The additional special case of added mass and damping can be modeled into the 
plant by adding the appropriate terms to Equations (3.4), (3.5), and (3.7) (see Appendix 
C for an explanation and derivation of the added mass and dampening equations). 

With the model of the plant, a controller for the flexible joint plant is designed as 
well as a a special case where the joint is considered rigid. A rigid body controller is 
designed to test its ability to control a plant with flexibility effects present. The design 
of the controller will be discussed in Chapter IV. 
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IV. CONTROLLER DESIGN 



A. CONTROL LAW 
1. Derivation 

The controller is designed using the following steps [Ref. I; p. 200]: 

The dynamic equation of motion, equation (3.4), can be solved for the motor 
position in terms of the arm position: 

6^ = dfi, + (4.1) 

Next differentiating Equation (4.1) twice with respect to time yields the following: 



0 = 
m 



- 



2k 



sin 6„ 



6a- 






(4.2) 



Substituting Equation (4.2) back into Equation (3.5) results in the following: 



A- 



+ E = r 



(4.3) 



where 









+ + cos0^ (4.4) 



See Figure 4 for the block diagram of the F equation. Equation (4.3) is a fourth order 
differential equation in terms of the arm variables alone. 
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Figure 4. Flexible Body Plant F Equation Super Block 
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Next, the concept of computed torque is utilized to determine the desired input 
torques as a function of the fourth and third derivatives, acceleration, velocity, and po- 
sition errors. The desired input torque can be written as: 

T., = ^ [e^ + K,(e, - 9) + K2(()^ - (j) + K,(e^ - 9) 

+ K„(9^-9)] + f 

where the K's are constants representing state error feedback gains. Assuming the non- 
linear F equation terms can be computed based on plant dynamics and the availability 
of measurements, equating Equation (4.3) and Equation (4.5) together results in: 

ej + K,(9 - ej + K,(e - + k, (9 - e,) 

+ K„(9-e,,)]-0 

Since J„, J^, and k are non zero. Equation (4.6) becomes: 

ii -f K3£ 4- K2£ + K]£ 4- Kq£ = 0 (4-^) 



where 



c = {d - e,) 

is the position error. As time oo , the steady state position error 
t = {d — dj) 0 (note this is true for specific K's obtained using the ITAE perform- 
ance criteria) [Ref 1; pp. 200-201]. 

ITAE performance criteria for a fourth order equation is used for the selection 
of the K values. The values are: 



17 



Kj = 2.lo) 



Kj = 3.4u)l 
K, = 2Jcol 
Ko = l.Oco^ 



(4.8) 



co„ represents the selected servo input speed to the system. [Ref. 8; pp. 129-130] 

A block diagram of the Flexible Body Controller is shown in Figure 5. 

2. Special Case of Rigid Body Model 

Referring back to equation (3.7), one can see a controller for the Rigid Body 
case can be developed along the same lines. Define the desired input torque equation 
as: 

= Om + h)0ci + Kv(0, - 0) + - e) + F (4.9) 



where 



F = 




cos 6 



(4.10) 



Equating equations (3.7) and (4.9) together and dividing out the non zero terms, the 
following results; 



£ -f K^,£ K^£ = 0 (4.11) 

To let this steady state error approach zero, K, and should be properly chosen. A 
block diagram of the Rigid Body Controller is shown in Figure 6. See Figure 7 for a 
block diagram of the Rigid Body Model F equation. 
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Figure 5. Flexible Body Model Controller Block Diagram 
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Figure 6. Rigid Body Model Controller 
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Figure 7. Rigid Body Model F Equation Block Diagram 
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B. OBSERVER DESIGN 



Referring back to equation (4.6), this external feedback linearization series requires 
the values of the second and third derivatives. These values are not measurable or 
available from the plant. 

Often it is not possible to achieve acceptable performance using only those state 
variables that can be measured. If the system is observable, it is possible to estimate 
those state variables that are not directly accessible to measurements using measuring 
data from those that are measurable. 

State variable estimates may in some circumstances be even preferable to direct 
measurements, because the errors produced by the instruments that provide the meas- 
urements may be larger than errors in estimating these variables. [Ref 9: p.259] 

A dynamic system whose variables are known can be estimated with the use of an 
observer. Luenberger [Ref 9: pp. 260-216] showed, that for any observable linear sys- 
tem, an observer can be designed having the property that the estimation error (the dif- 
ference between the state variables of the actual system and the variables of the 
observer) can be made to go to zero as fast as one wants. 

A state observer is designed to estimate the values of 6 and 6 . The observer is 
shown in Figure 8 and in Figure 9. 

A mathematical derivation of the observer used in this research is presented in Ap- 
pendix D. 
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Figure 8. Observer Super Block Diagram 
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Figure 9. Obsener Sub Block Diagram 
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V. EVALUATIONS 



After designing the flexible-body controller and reviewing the special case of the 
rigid-body controller, a comparison will be conducted between the tw’o controllers. The 
comparison will be focused on responding speed, payload capacity and torque require- 
ment. The first set of comparisons will be between the two methods of feedback for 
rigid-body control (arm feedback and motor feedback). The second set of comparisons 
will be between the rigid-body control (using the best method of feedback) and flexible- 
body control. 

A. RIGID-BODY CONTROL 

Simulations were conducted for the special case of the Rigid-Body Controller in or- 
der to investigate its performance characteristics. The controller was used to control a 
plant with joint flexibility. The parameters used in the simulation were from the third 
joint of the PUMA 560 Robot arm. 

m„ = 4.8 kg 

= 0.086 kg - m^ 

= 0.83 kg — m^ 
k = 11650 

rad 

G, = 53.69 
la 

— = 0.007 meter 
hj) = 0.439 meter 
Md = 2.5 kg 

For the Rigid-Body case, there are two methods of feedback, namely, feedback from 
the tip (arm) position and feedback from the motor position. To demonstrate and 
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evaluate the rigid-body controller, both methods of feedback will be investigated. The 
servo input speeds used were co„ = 1 and to„ = 4. The following three outputs will be 

shown for each method and speed: 

1. Arm position 

2. Torque requirements 

3. Small motion differences 

Note, on the graph of small motion (the difference between the arm position and the 
motor position), the major line is the servo control mode which is the result of the entire 
system movement. The second part is the mechanical vibration superimposed onto the 
servo mode. 

1. Rigid Body with o„ = I 

The graphs for arm feedback are shown in Figure 10, Figure 11, and in 
Figure 12. The graphs for the motor feedback are show^n in Figure 13, Figure 14, and 
in Figure 15. 

As shown in Figure 10, an unacceptable long settling time occurred for arm 
feedback. The cycle time is longer also for the arm feedback case. In the motor feed- 
back case, the arm settles at the desired position of 5 radians after 7.4 seconds. Looking 
at Figure 12, and Figure 15, the servo control mode amplitude dilference is similar be- 
tween the two cases but the mechanical vibration (spikes) is more pronounced for the 
arm feedback case. Looking at Figure 1 1 and Figure 14, the torque is 32 times lower 
for arm feedback than for motor feedback. The key point here is the motor feedback 
provides overall superior performances but at an high torque requirement. 

2. Rigid Body with <o„ = 4 

The servo input speed was increased to co„ = 4 to further study the effects of 
increased speed on performance. The graphs for arm feedback are shown in Figure 16, 
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Figure 10. Rigid Body Model Arm feedBack (OJ 
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Rigid Body Model Arm feedBack (torque) 
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Figure 12. Rigid Body Model Arm feedBack (small motion) 
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Figure 13. Rigid Body Model Motor feedback (0J 
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Figure 14. Rigid Body Model Motor feedback (torque) 
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Figure 15. Rigid Body Model Motor feedBack (small motion) 
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Figure 17, and Figure 18. The graphs for the motor feedback are shown in Figure 19, 
Figure 20, Figure 21, and in Figure 22. 

As shown in Figure 16, the systems response time has increased, but after 40 
seconds it still has not settled out. The motor feedback settling time has decreased to 
1.9 seconds (Figure 19). Another area to look at is the increased in the level of small 
motion (Figure 21) and (Figure 18). The mechanical vibration has increased for both 
cases but the level is still less for the motor feedback configuration. The torque re- 
quirements for motor feedback case (Figure 20) has increased by a factor of 14. 

Appendix E presents additional simulation runs for the motor feedback config- 
uration. In each situation a step input with a desired final position of' 6^ = 5 was used 
unless otherwise noted. 

Although the controller was designed via pole placement using coefficients 
based on ITAE performance criteria, in the comparison between the two rigid body 
cases, the motor feedback case obviously demonstrated the best performance character- 
istics based on rise time, settling time, servo control mode amplitude difierence, me- 
chanical vibration and system respond time. The only weakness noted is in the area of 
torque requirements. The levels for the motor feedback configuration far exceeded the 
requirements for the arm feedback case ( by 32 times for <x>„ = 1 and 46 times for = 
4). The results of the rigid body comparisons are listed in Table 1 on page 41. 
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34 



Time (seconds) 

Rigid Body Design (arm feedback wn='1 ) 




o 



LO 

n 



o 

n 



m 

(N 



o 

04 



U'D 



o 









[ S J 8 j LU - U O AA ^ U ) 0 n t> J O J_ 



Figure 17. Rigid Body Model Arm feedBack (torque) 
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Figure 18. Rigid Body Model Arm feedBack (small motion) 
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Figure 19. Rigid Body Model Motor feed back (0J 
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Time (seconds) 

Rigid Body Model (wn=4 zeto=0 mass=0) 
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Time (seconds) 

Rigid Body Model (wn=4 zeta=0 mass=0) 
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Figure 21. Rigid Body Model Motor feedBack (small motion) 
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Figure 22. Rigid Body Model Motor feedBack (small motion) 
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Time (seconds) 

Rigid Body Model (wn=4 zeto=0 mass=0) 



Table 1. RIGID BODY MODEL COMPARISON 





ARM FEEDBACK 


MOTOR FEEDBACK 


wn = 1 

C = 0 


wn = 4 

C = 0 


II d 
II 

o 


wn = 4 

C = 0 


Rise Time (seconds) 


11.8 


3.0 


3.4 


0.8 


Settling Time (seconds) 


<*- 


★ 


7.4 


1.9 


Maximum Torque (N-m) 


7.8 


76.0 


248.0 


3500.0 


Servo Control .Mode Ampli- 
tude Absolute difference 
(radians) 


0.0001 


0.0002 


0.0003 


0.0004 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.008 


0.018 


0.0010 


0.0019 


Slope (Speed) (rad s) 


0.46 


1.66 


1.47 


6.67 



* Note the graph had not settled out by the end of the simulation run. 



While the motor feedback case seems promising, there still is a need for im- 
provements in the areas of: 

1. Lower Torque Requirements 

2. Less Mechanical Vibrations 

3. Lower Servo Mode Small Motion DilTerences 

4. Less .Mechanical Electric wear on actuator 

Therefore the flexible-body control will be compared against the rigid-body 
control using motor feedback to determine if there is an improvement in performance 
characteristics. Due to the fact the Flexible-Body is a fourth order controller, the servo 
speed input will be run slightly higher in order to make realistic comparisons. A point 
to point and trajectory tracking control scheme were used. Added mass was analyzed 
in the simulations also. 
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B. FLEXIBLE-BODY CONTROLLER 



1. Point to Point Control - No Load 

The graphs for motor feedback are shown in Figure 13, Figure 14, and 
Figure 15. The graphs for the flexible body controller are shown in Figure 23, 
Figure 24, and Figure 25. 

Reviewing the flexible-body graphs and the rigid-body graphs, the flexible-body 
controller provides improvements in all characteristic areas with a decrease in required 
torque. All this occurs with the flexible-body controller moving at a faster servo input 
speed. Other than one large spike at 0.8 seconds, the flexible-body model exhibited 6 
times less mechanical vibration. The servo control mode amplitude difference was sim- 
ilar between the two cases. With an increase in input servo speed, the servo control 
mode amplitude difference and mechanical vibrations increased as expected. 

The second simulation analyzed the effect of increased servo input speed on the 
performance characteristics of the two controllers. As seen in Table 2 on page 46, the 
flexible-body controller still requires less torque, generates less mechanical vibration and 
has a steeper slope than the rigid-body controller. The steeper slope equates to a more 
responsive system. The servo control mode amplitude difference was also lower than the 
rigid-body model. The graphs of these simulation runs are in Appendix E. 
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Figure 23. Flexible Body Model (0,) 
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Time (seconds) 

Flexible Body Model (wn = 2.0 zeto=0 mass=0) 
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Figure 24. Flexible Body Model (torque) 
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Time (seconds) 

Flexible Body Model (wn=2.0 zet.a=0 mass=0) 
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Figure 25. Flexible Body Model (small motion) 
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Time (seconds) 

Flexible Body Model (wn=2.0 zeto=0 moss=0) 



Table 2. FLEXIBLE BODY VS RIGID BODY MODEL - NO LOAD 





Flexible Body Model 


Rigid Body Model 


II s 
II 


II 

s II 


wn= 1 

C = 0 


II s 
II 


Rise Time (seconds) 


2.2 


0.8 


3.4 


1.0 


Settling Time (seconds) 


3.2 


2.1 


7.4 


2.5 


Maximum Torque (X-m) 


222.0 


870.0 


248.0 


1910.0 


Servo Control .Mode Ampli- 
tude Absolute difference 
(radians) 


0.0003 


0.0003 


0.0003 


0.0003 


.Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.0005 


0.0005 


0.0010 


0.0015 


Slope (Speed) (rad s) 


2.27 


6.25 


1.47 


5.00 



2. Load and Speed Considerations 

Since the main purpose for studying a controller is to determine if it can perform 
its designed tasks, a comparison of two different loads (1.36 kg and 2.5 kg) and various 
speeds were investigated in order to study the difference in capabilities between the two 
methods or control. Again since the flexible-body is a fourth order controller, the servo 
input speed was ran slightly higher in order to allow more realistic comparisons. The 
comparable speeds used were o)„ = 1 and = 3 for rigid-body control and co„ = 2 
and (o„ = 4 for flexible-body control. The graphs of the robot arm positions can be 
seen in Figure 26 through Figure 33. 

As can be seen in Table 3 on page 55 and Table 4 on page 56, as the load in- 
creases, the torque requirements has increase by a factor of 8 (from 312 N'-m to 2505 
N-m for 1.36 kg and 370 X-m to 2900 X-m for 2.5 kg) for the rigid-body model but the 
flexible-body model experienced only an increase of a factor of 3.8 (from 231 X-m to 900 
X-m for 1.36 kg and 238 X-m to 900 X-m for 2.5 kg). The servo control mode amplitude 
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Figure 26. Flexible Body Model (0,) 
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Time (seconds) 

Flexible Body (wn=2 zeha=0.01 mass=1.36 kg) 
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Figure 27. Flexible Body Model (OJ 
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Figure 28. Rigid Body Model (0.) 
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Time (seconds) " 

Rigid Body (wn=1 zeta=0.01 mass=1.36 kg) 
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Figure 29. Rigid Body Model { 0 ,) 



50 



Time (seconds) 

Rigid Body (wn=5 2eto=0.01 moss=1,36 kg) 
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Figure 30. Flexible Body Model (0,) 
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Figure 31. Flexible Body Model (0,) 
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Figure 32. Rigid Body Model ( 0 ,) 
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Time (seconds) 

Rigid Body Model (motor feedback wn=1 zeta=0.01 mas 



rri 







c\ 



O 



CO 



^s? 






t J 



O 






io 



r’ \ 

"T/ 

c: 

O 

f » 

d- 

r*> 

V_-' 



c-i 

II 

D 

L- 



a> J:.. 

E ?i 

t— 



II 



c 



V 

ri 

lij 

‘c3i 

iiT 



(SUDlpDj) V 



Figure 33. Rigid Body Model (0.) 
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difTerence has increase by 2.5 for the rigid body model but only by 1.8 for the flexible- 
body controller for the same load change. The rigid-body controller experienced more 
mechanical vibration as can be seen in Table 3 on page 55 and Table 4 on page 56. 
Also the rise time has slowed down for the rigid-body controller as the load increases. 
As the servo speed input increases, the rigid-body control experience higher torque re- 
quirement changes, higher level of mechanical vibration and larger servo control mode 
amplitude differences. The flexible-body control requires less torque, experience less 
mechanical vibration and smaller servo control mode amplitude for a comparable speed 
increase. The rise time is quicker for flexible-body control for a comparable increase in 
servo input speed. 



Table 3. FLEXIBLE BODY VS RIGID BODY MODEL - 1.36 KG 





Flexible Body Model 


Rigid Body Model 




O 

O II II 


wn = 4 

c = 
0.01 


wn= 1 
C = 
0.01 


wn = 3 

C = 
0.01 


Rise Time (seconds) 


2.3 


1.3 


3.7 


1.8 


Settling Time (seconds) 


5.5 


2.7 


5.0 


3.0 


Maximum Torque (N-m) 


231.0 


900.0 


312.0 


2505.0 


Servo Control Mode Ampli- 
tude Absolute diflerence 
(radians) 


0.0037 


0.0068 


0.0025 


0.0062 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.0015 


0.0015 


0.0015 


0.0045 


Slope (Speed) (rad s) 


2.17 


3.85 


1.35 


2.78 
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Table 4. FLEXIBLE BODY VS RIGID BODY MODEL - 2.5 KG 





Flexible Body Model 


Rigid Body Model 




wn= 2 

C = 
0.01 


wn = 4 

C = 
0.01 


wn= 1 

C = 
0.01 


>vn = 3 

C = 
0.01 


Rise Time (seconds) 


2.3 


1.1 


4.0 


1.5 


Settling Time (seconds) 


5.5 


2.8 


6.0 


4.0 


Maximum Torque (N-m) 


238.0 


900.0 


370.0 


2900.0 


Servo Control .Mode Ampli- 
tude Absolute difference 
(radians) 


0.0050 


0.0090 


0.0034 


0.0080 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.0020 


0.0025 


0.0028 


0.0070 


Slope (Speed) (rad s) 


2.20 


4.54 


1.25 


3.33 



The mass increase had little efTect on the performance of the flexible-body con- 
troller but the rigid-body controller stability has decrease. The robot arm position 
graphs for the rigid-body case exhibit little or no overshoot as required by the ITAE 
criteria used to design the controller. The mechanical vibration of the rigid-body control 
system has increased also for both a speed increase as well as a mass increase. 

From the stand point of desirability, the flexible-body controller moves the 
added mass faster with less vibration or system wear, and with less torque. The 
flexible-body controller still continues to demonstrate superior performance character- 
istics even with a load placed at the tip position and a comparable speed increase. 

The torque and small motion graphs can be viewed in Appendix E. 

As shown by the graphs, the flexible-body controller again outperformed the 
rigid-body controller. The flexible-body controller requires less torque to move the 
added mass and does it at a faster speed. The mechanical vibration is less for the 
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Flexible-Body case even though the servo control mode difTerence is similar beween the 
two controllers. 

3. Trajectory Motion 

The next simulation involved a trajectory tracking with and without an added 
mass. The trajectorv' tracking was a combination of a steady ramp input with a leveling 
off at 4 seconds and a desired arm position of five radians. Next, after holding the input 
at a constant value in order to maintain an arm position of five radians, a negative ramp 
input at 10.5 seconds was used to bring the arm back to its starting position at approx- 
imately 16 seconds. The results of the simulation are hsted in Table 5. The graphs of 
the robot arm motion can be seen in Figure 34 through Figure 37. The other graphs 
are in Appendix E. 



Table 5. FLEXIBLE BODY VS RIGID BODY MODEL - TRAJECTORY 





Flexible Body Model 


Rigid Body Model 


wn = 2 

c = 

0 

no mass 


wn = 2 

C = 

0 

added mass 
2.5 kg 


wn= 1 
C = 

0 

no mass 


wn= 1 

C = 

0 

added mass 
2.5 kg 


Desired Rise Time (seconds) 


4.0 


4.0 


4.0 


4.0 


Settling Time (seconds) * 


6.5 


6.3 


7.5 


7.0 


-Maximum Torque (N-m) 


92.0 


110.0 


98.00 


140.0 


Servo Control Mode Ampli- 
tude Absolute difierence 
(radians) 


0.00029 


0.0026 


0.0004 


0.0080 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.00020 


0.00060 


0.0010 


0.0050 


Desired Slope (Speed) (rad s) 


1.25 


1.25 


1.25 


1.25 



* For the level portion of the trajectoiy between the two ramps only 



As seen in Figure 34 through Figure 37, there is a more pronouned overshoot 
than found on the point to point control. This is due to the momentum left over in the 
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Figure 34. Flexible Body Model Trajectory' 
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Time (seconds) 

Flexible Body Model (wn=2 zeta=0 mass=0) ramp input 
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Figure 35. Flexible Body Model Trajectorj' (0J 
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Time (seconds) 

Flexible Body Model (wn=2 zeto=0,01 mass=2.5 kg) ramp input 
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Figure 36. Rigid Body Model Trajectory (0,) 
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Time (seconds) 

Rigid Body Model (motor feedback wn=1 zeta=0 mas3=0) 
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Figure 37. Rigid Body Model Trajectory' {$,) 
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Time (seconds) 

Rigid Body Model (motor feedback wn=1 zeta=0.01 mass=2.5 kg) 



system as it reaches the desired position. It overshoots the position and gradually settles 
down to the final position. Due to the fact the controller gradually rises the arm to its 
desired position instead of a sudden jump similar to point to point control, less torque 
is required to perform the same movement. As a result less mechanical vibration is de- 
tected and the servo control mode amplitude is less. The desired trajectory was designed 
to lower the speed response to the desired trajectory at the saving of wear and tear on 
the equipment. With less torque required, this tracking method would consume less 
energy. The flexible-body controller still was able to outperform the rigid-body con- 
troller. With an increase in load, the flexible-body control servo control mode amplitude 
was less than the rigid-body control experiencing the same load increases. Also the 
mechanical vibration and the torque requirements were less for the flexible-body control. 
But even still the trajectory tracking allows larger masses to be handled at a lower re- 
quired torque than do the point to point control method. For comparable speed in- 
creases, similar results were obtained. The level of mechanical vibration and the servo 
control mode amplitude were greater for the rigid-body control. The torque require- 
ments were also greater for the rigid-body control. The the relative stability were similar 
for both the flexible-body and rigid-body control. 

Overall observation is the trajectory tracking required less torque to move a 
mass than the point to point control required to move the arm with no mass attached. 
Also the loaded condition reached a relative stability condition faster than the unloaded 
case. An increase in load from 0 kg to 2.5 kg and comparable increases in servo input 
speeds resulted in an increase in the mechanical vibration and servo control mode am- 
plitude for both controllers, with the rigid-body controller level of vibration being 
slightly higher than the flexible-body controller. But the overall level of mechanical vi- 
bration and servo control mode amplitude difference for the trajectory tracking method 
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is less than the vibration level and servo control mode amplitude difference for the point 
to point control method. 

C. TORQUE SATURATION CONSIDERATIONS 

The simulation analysis up to this point has not considered an input torque limita- 
tion on the motor for the actuator. Since the PUMA Robot arm is used as the model 
for this research work, the limitation of the model should be included in the analysis of 
the flexible body controller. The PUMA Robot arm was designed as a rigid body device 
which restricts any flexibility in its operation. 

A saturation device was included in the design in order to study the performance 
characteristics of the controller controlling the PU.MA Robot arm. A value of 49.2 
nevnon-meters was used as the torque saturation point (49.2 newion-meters is the 
torque limit of the third joint motor on the PU.MA arm). 

First the performance of the Rigid Body case will be looked at and finally the Flex- 
ible Body case will be reviewed. 

1. Rigid Body Saturation Case 

For the graphs of the Rigid Body case with saturation included, see Figure 38 
for point to point control and Figure 39 and Figure 40 for trajectory' control. For the 
Rigid Body case, when the the torque value exceeded the preset limit of 49.2 newton- 
meters, the curve flattened out until the torque decreased below’ the preset limit. The 
servo control mode amplitude and the mechanical vibration results are similar to the 
cases without torque limitation included. The rise time for the saturation case is slower 
and the settling time is longer. For a summary of the rigid body simulations see 
Table 6 on page 67. 
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Figure 38. Rigid Body Model (saturation) 
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Time (seconds) 

Rigid Body Model (wn=1 zeta=0 mass=0) 
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Figure 39. Rigid Body Model (saturation) 




65 



Time (seconds) ramp 

Rigid Body Mode! (wn=1 zeta=0.O1 mass=2.5 kg) (sat) 




Figure 40. Rigid Body Model (saturation) 
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Time (seconds) ramp 

Rigid Body Model (wn=1 zeta=0.01 mass=2.5 kg) (sat) 



Table 6. RIGID BODY TORQUE LIMITATION RESULTS 





Point to Point 
Tracking Con- 
trol 


Trajectory 
Tracking Con- 
trol 


Trajectory 
Tracking Con- 
trol 


WT1= 1 

c = 

0 

no load 


wn= 1 

C = 

0 

no load 


wn= I 

c = 

0 

mass = 
2.5 kg 


Maximum Torque (N-m) 


49.2 


49.2 


49.2 


Servo Control .Mode Ampli- 
tude Absolute difference 
(radians) 


0.0003 


0.0004 


0.003 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.0055 


0.0024 


0.0070 


.Maximum Overshoot 
(radians) 


5.2 


5.7 


5.6 



2. Flexible Body Saturation Case 

For graphs of the flexible body case with saturation included, see Figure 41 and 
Figure 42 for point to point control and Figure 43 for trajectory control. 

For the point to point control with input servo speed of (o„ = 2, the torque 
curve had a secondary frequency mode superimposed on it during the time input torque 
exceeded the imposed limit. This was present only at (o„ greater than one. Overshoot 
of the final desired position was higher for the saturation cases. This was due to the 
momentum which was still present in the system after the torque limitation was reached. 
The servo control mode amplitude differences are similar to the non saturation cases but 
the mechanical vibration was higher for the torque saturation cases. Using the trajec- 
tory tracking method with added mass (Figure 43), the controller was still able to move 
the mass to the desired arm position but at a reduced level of performance when com- 
pared to the case where motor torque limitations are not considered. 
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Flexible Body Model (saturation) 
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Figure 42. Flexible Body Model (saturation) 
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Time (seconds) 

Flexible Body Model (wn=2 ieta=0 mass=0) (sat) 
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Figure 43. Flexible Body Model (saturation) 
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Time (seconds) ramp 

Flexible Body Model (wn=2 zeio=0.01 mass=2.5 kg) (sat) 



The Flexible-Body controller was still able to control the plant at a greater per- 
formance level than the Rigid-Body controller in the areas of less mechanical vibration, 
smaller servo mode amplitude differences and quicker settling times, but its performance 
was degraded due to the limitation of the torque motor input. For a summar}’ of flexible 
body model simulations see Table 7. 



Table 7. FLEXIBLE BODY TORQUE LIMITATION RESULTS 





Point to Point 
Tracking Con- 
trol 


Trajectory 
Tracking Con- 
trol 


Trajectory 
Tracking Con- 
trol 


wn = 2 

c = 

0 

no load 


wn= 2 

c = 

0 

no load 


wn = 2 
C = 

0 

mass = 
2.5 kg 


.Maximum Torque (N-m) 


49.2 


49.2 


49.2 


Servo Control Mode Ampli- 
tude Absolute difference 
(radians) 


0.0003 


0.0003 


0.0034 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


0.0005 


0.0008 


0.0020 


Maximum Overshoot 
(radians) 


5.8 


6.0 


6.02 



D. DISCUSSION 

I. Rigid Body Results 

The performance of the motor feedback method of control remains superior to 
the arm feedback method for all servo bandwidths. With its long settling time, the arm 
feedback is unacceptable as a method of control. This poor performance is due to the 
fact the sensors and actuators used for control are separated by the flexible structure of 
the transmission line and gears. The flexibility of the system introduces noise in the 
feedback loop which in turn produces erroneous or inaccurate signals to be received by 
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the controller. The motor feedback, on the other hand, is not faced with this predica- 
ment. Its sensor and actuator are located together and is not faced with this unwanted 
disturbance or noise. 

Another key point are the two parts of the small motion (the difference between 
the arm position and the motor position) graph. The major line is the servo control 
mode which is the result of the entire system movement. The second part is the me- 
chanical vibration superimposed onto the servo mode. As the servo input frequency is 
increased, the sert o mode motion increased with a slight increase in mechanical vi- 
bration. This is due to the fact the servo frequency moves towards the systems na- 
tural frequency a»o When damping is introduced, the mechanical vibration decreases 
slightly while the servo mode increases. With the addition of C , the system's natural 
frequency decreases to (o^. With this decrease in natural frequency which relates to a 
movement towards the servo input frequency, the excitation of the system increases due 
to this closer position of to oy„. 

1 . Flexible Body Results 

The Flexible Body Model has demonstrated improved characteristics in each of 
the areas which were measured. One superior quality was the ability of the controller 
to move at a faster rate yet use less torque while the Rigid Body controller required more 
torque while moving at a slower speed. This means the Flexible controller has the ca- 
pability to control greater payloads, provide more accuracy and could possibly consume 
less energy. The results of the simulations are listed in the tables on the pages to follow. 
The results of the Rigid Body Model comparison is listed in Table 1 on page 41 below. 
To see the Flexible Body Model vs Rigid Body Model results see Table 2 on page 46. 
To review the effects of damping on the Rigid Body and Flexible Body Model both with 
input speed increases and added mass increases see Table 3 on page 55 and Table 4 on 
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page 56. To see the results of trajectory' tracking effects on the Flexible Body Model and 
Rigid Body Model see Table 5 on page 57. 

3. Saturation Case Results 

For the cases where torque saturation was considered, the Flexible Body con- 
troller performance characteristics deteriorated as the result of the limitation of the ri- 
gidity of the PUMA Robot arm. The level of mechanical vibration increased and the 
servo mode level increased also. At an input servo speed of co„ greater than one, sec- 
ondary' frequencies of the servo system were superimposed on the torque curves where 
the level exceeded the preset torque limit (since the Flexible Body controller is a fourth 
order equation, is has an additional frequency mode which is not present in the Rigid 
Body controller). For the added mass case, the flexible body controller was still able to 
control the plant. The performance characteristic were superior to the Rigid Body con- 
troller in the areas of less mechanical vibration, smaller servo control mode amplitude 
differences and quicker settling times. However, the performance of the controller was 
still degraded. The controller needs to operate with a plant designed with flexibility. 
The PU.MA plant is designed to be a rigid plant and therefore restricts the capability of 
the flexible body controller. The controller stability has decreased as a result of this re- 
striction in motor torque. The results of saturation effects on the Rigid Body Model can 
be seen in Table 6 on page 67 and the results of the Flexible Body Mode experiencing 
torque limitation can be reviewed in in Table 7 on page 71. 

In Figure 44 is the Super Block diagram of the entire system of the Flexible 
Body .Model. In Figure 45 is displayed the Super Block diagram of the Rigid Body 
Model system. 

Additional simulations were run at various input speeds, with and without 
damping. These runs without explanation can be reviewed in Appendix E. The graphs 
are self explanatory. The desired final position of 5 radians was used in all cases. 
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Figure 44. Flexible Body Model Super Block 
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Figure 45. Rigid Body Model Super Block 
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VI. CONCLUSIONS 



A. INSIGHTS 

The flexible-body controller performance was superior to the rigid body controller. 

The results of the comparisons between the two controllers are summarized as follows: 

1. With an increase in input servo speed, the rigid body had a higher Mechanical vi- 
bration level 

2. The flexible body model required less torque even at a higher input speeds 

3. The flexible body model proved to be a responsive robust system over the range 
of speeds and conditions tested 

4. The torque requirement for the added mass case was less for the flexible-body 
controller 

5. The flexible body model performance characteristics were superior to a rigid body 
for both an increase in load and speed 

6. A ramp input requires a lower torque requirement w'ith no increase in servo mode 
or mechanical vibration 

7. The flexible-body controller using a ramp trajectory' was able to handle a greater 
load with an improvement in all performance characteristics except rise time which 
increased slightly 

It appears the results obtained points towards selecting the flexible body controller. 
However, since the results are based on simulations, more comparisons should be con- 
ducted at more speeds and a variety of loads. This research considered the the flexibility 
in the gear coupling and neglected gear backlash. 

The case of the torque limitation did point out some of the limitations of the 
flexible-body controller. The performance characteristics deteriorated as the result of the 
limitation of available input servo torque. The level of mechanical vibration increased 
and the servo mode level increased also. At input servo speeds greater than cu„ = 1, 
secondaiy frequencies of the servo system were superimposed on the torque curve where 
the torque required exceeded the preset level. Results in the simulations indicate that 
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actuator saturation may be the only significant nonlinearity in the robot motion design 
problem. 

B. RECOMMENDATIONS 

The following recommendations are submitted: 

1. Continue further study of the Flexible Body Model under varies simulated condi- 
tions and load. 

2. Build a Flexible Body Controller and test it on the PUMA Robot. 

3. Extend the present study of the Flexible Manipulator to include more than one 
joint. 



Additional suggestions are: 

1 . The flexible body controller be used at input speeds which do not exceed the satu- 
ration level or the actuator. 

2. The fle.xible body controller be tested on plants which were design to be flexible. 
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APPENDIX A. MATRIX;^ 

A. MATRIX^ 

MATRIX^ is a Computer Aided Engineering software package for modeling, simu- 
lation, engineering analysis, control design, signal processing, and system identification. 

MATRIX^ , is a programmable, matrix solving software package with emphasis on 
controls applications. Scalar functions as well as complex, large-scale matrix problems 
can be solved using the state-of-the art matrix analysis functions built into MATRIX^ . 
MATRIX^ can be used to solve complex, large-scale matrix problems in an engineering 
discipline. However, it is bested used in the analysis of control engineering related 
problems. MATRIXES- was designed to have a complete set of design and analysis func- 
tions for input/output (classical) control and state-space (modem) control." [Ref 10] 

Control systems are concerned with the control of specific variables. The interre- 
lationship of the controlled variables to the controlling variables is required. This re- 
lationship is typically represented by the transfer function of the subsystem relating the 
input and output variables. Therefore, the transfer function is an important relation for 
control engineering. The importance of the cause and effsct relationship of the transfer 
function is evidence by representing the relationship of the system by use of diagrams 
called block diagrams. 

The block diagram representation of a system's relationships is prevalent in control 
system engineering. Block diagrams consist of unidirectional, operational blocks that 
represent the transfer function of the variables of interest. Once the block diagram is 
developed, a transfer function relation is defined, and the system is analyzed using the 
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transfer function. MATRIX^ has a feature called SYSTE.M_BU1LD2 which solves linear 
or non-linear control problems directly from block diagrams. 

B. SYSTEM_BUILD 

SYSTEM_BUILD is an interactive, menu-driven graphical environment for building, 
modifying computer simulation models. Any combination of linear, non-linear, 
continuous-time or discrete-time models that describe a system can be constructed from 
a libraiy^ of more that 70 distinct block types. Simulating system performance under 
both nominal and constrained environments is easily accomplished with 
SYSTE.M_BU1LD. (Ref 11: pp. SB P-l-SB P-2] 

Systems are modeled by dividing them into individual components, and each com- 
ponents is described by a specific type of functional block. A group of functional blocks 
are called Super Blocks, and Super Blocks can be nested together within another Super 
Block. Once a system is modeled in SYSTE.M_BU1LD, The system is analyzed in the 
MATRIX^ interpreter. Any system modeled in SYSTEM_BLTLD can be simulated, 
linearized, and analyzed through the use integration algorithms, built into the 
MATRIX, interpreter, which are suitable for simulating a variety of systems. 
[Ref IT. pp. SB P-1] 



2 SVSTE.M_BU1LD is a trademark of Integrated Systems Incorporated. 
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APPENDIX B. PUMA 560 ROBOT DESCRIPTION 



The Puma 560 Robot is an industrial robot system with six degrees of freedom. It 
is comprised of a robot arm (Figure 46) [Ref. 6: p. 1-20], a controller, software, and 
other peripherals. It is designed to manipulate nominal end-effector load of 2.5 kilo- 
grams. With a positional repeatability of 0.1 milli-meters. It has a spherical work en- 
velope of 0.92 meters (Figure 47) [Ref. 6; p. 2-2). Its drive is an electric DC servomotor. 
The maximum tool acceleration is I G with a maximum tool velocity of 1.0 meter per 
second (with maximum load within the primaiy work envelope). The maximum static 
force at the tool is 58 neutons. The arm assembly is driven by a permanent-magnet DC 
servomotor driving through its associated gear train. The motor contains an incremental 
encoder and a potentiometer driven through a 116 to I gear reduction. The motor is 
housed in the upper arm. The gear train is housed in the elbow end of the upper arm 
and is connected to the motor by a drive shaft. A bevel pinion on the input shaft drives 
a bevel gear on one end of an idler shaft. A spur pinion at the other end of the idler 
shaft engages a bull gear fixed to the forearm, and so rotates the forearm around the 
elbow axis. [Ref 6: pp. 1-22-1-25] 

The PUM.A 560 Robot is controlled by a closed-loop control system. Incremental 
encoders and potentiometers at each drive motor provide the positional feedback for the 
control system. Each of the joint encoders provides a resolution of appro.ximately 0.005 
degree/bit . The PUMA 560 robot can also be positioned using transformations. 
[Ref 12] 
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Figure 46. PUMA60 Robot Ann 
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Figure 47. Robot Ann Operating Envelope 
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APPENDIX C. ADDED MASS AND DAMPING 



A. ADDED MASS EQUATIONS 

For added mass, the term is revised to include the additional mass which is placed 
at the arm tip position. The appropriate term is: 

M^L^cos0q (G.l) 



which is added to Equations (3.4) and (3.7). The following term MoL\, is added to the 
term which results in a new term ij', which represents the moment of inertia for the 
link (arm) and the added mass (see Figure 48). 

Now performing the derivation for the controller as presented in Chapter Four with 
the additional added mass terms, the revised F equation (Equation 4.4) will be: 



F = }, 



G, — sin sm ]d^ 



m,g 

+ : |0„cos0.. 



2k ' k 
+ (m^gl + Mo^Lo)cos0^ 



+ 



(C.2) 



Figure 49 illustrates the block diagram elements which are added to the F equation 
inorder to revise the Flexible Body Model overall system equations. By setting mass 
equal to zero (for no added mass) these terms do not effect the simulation of the plant. 
See Figure 4 for a block diagram of the F equation. 

For the special case of the Rigid Body Model, the F equation (Equation 4.9) is 
modified as shown: 



F= mag4rcosd + M/)^L^cos0 



(C.3) 
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Figure 48. J,T Added Mass Terms 
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Figure 49. Flexible Body Model Added Mass Block 
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See Figure 7 for a block diagram of the Rigid Body Model F equation with the place- 
ments of the added mass terms. 

B. DAMPING 

Damping is considered in both the Flexible Body Model and the Rigid Body Model. 
The following term is added to equations 3.4, 3.5, and 3.7 



in order to observe the performance characteristics of the two models with and without 
damping. See Figure 50 for a block diagram of the damping term. 




(C4) 




(C.5) 
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Figure 50. Damping Block Diagram 
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APPENDIX D. STATE OBSERVER DERIVATION 



A. BACKGROUND 

A dynamic system can be represented in state-space form by the following equation: 

X = Ax + bu (D.l) 



A control law of 



u = — Gx 
X = (A — bG)x 



(D.2) 



can be assumed if 'x' is accessible for measurements. But instead of being able to 
measure the state 'x', one can only measure 

y = Cx (D3) 



where the dimension m of the observation vector y is less than the dimension of x 
[Ref. 9: p.260]. 

Errors inevitably will be present in the measurement of y(t). These errors mean only 
an estimate for x(i) of x(t) can be made and never x(t) itself [Ref 13] 

A better procedure for obtaining an estimate of x(/) is to make the estimate, the 
output of a dynamic system. 



X = AJc + Bu + Ky (D.4) 

A A 

The system is excited by 'y' and input 'u'. By selecting the matrices A, B , and K, the 
error can be made equal to 
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e = 



X 



X 

or 



~ A 

X = jr — X 



Let a difierential equation be equal to 



t = {A - KQe 



w'here 



^2 

r 

k;. 

C = [c,.C2,.,.,cJ 



[Ref. 9: pp. 260-261]. 

Pole placement is to place poles of the feedback system at desired locations. 



■^■11 • 



are desired eigenvalues, and the characteristic polynomial is 



(S-;.,)(5-;.2)...(S-;.,) = S" + a,S"-'+ ... +a, 



In other words, pole placement lets 



I SI{A -bG)\=S^ + a,S*’’ + ... 



(D.5) 



(Z).6) 



(Z).7) 



Assume 

(Z).S) 



(Z).9) 



(D.IO) 
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multiple input multiple output systems, G has 1 x k unknowns ( 1 is the number of in- 
puts). The solution of G is not unique. Next a matrix N will be defined as 



N=[C',A'C, ..,A'*"’C'] 
C = transpose of matrix C 



Matrix 'W' equals 



1 a, 




0 1 


• ^k-2 



0 . . 1 



Now a term K' will be defined as 



K' = (a - a)(.V{10“' 



where 



A TA A A “I 

a = [a, aj . . a J 
a = [a, a 2 . . aj 



a terms are the desired coefficients of the characteristic polynomial, 'a' 
obtained from the ITAE criteria for a third order equation since 'a' is a 

B. OBSERVER FOR FLEXIBLE JOINT ROBOT 

The system in this research will be described by the following state 
tation: 



'^2 



Am 

A21 




+ 



B, 

B 2 




+ 







(£>. 12 ) 



(ZJ.13) 



(Z).14) 

coefficients are 
1 X 3 matrix. 

space represen- 
(£>.15) 



90 



Now make the following relationships: 



z, = e 
Z2 = B 
Z3 = B 

Z4 = B 



z, = Z2 

z-L = Z3 

Z3 = Z4 



From Equation (4.3) 



z, = B = 



K 






T - 



K 






-/ 



X, = {z,} = (0) 





1 

N 

K) 

1 




1 


X2 = 


Z3 


= 


6 




1 

tsi 

1 




B 



Substituting values into equation (D.15), results in the following equation: 



Zl 




0 10 0 


Z) 


Z 2 




0 0 10 


Z 2 


Z 3 




0 0 0 1 


Z 3 


Z 4 




0 0 0 0 

^ _ 


_Z4^ 







~ 


0 




0 


0 


T - 


0 


0 




0 


K 




K 


_ 







Referring back to equation (D.15), 



A) ) is a 1 X 1 matrix 
A)2 is a 1 X 3 matrix 
A21 is a 3 X 1 matrix 
A22 is a 3 x 3 matrix 



(Z).16) 



(D.17) 



(Z).18) 
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Expanding equation (D.15) results in the following 



X2 = A22X2 + A2 ]Xi + B2W + 

~ yi + ^1 ~ AjiXi — B,u = AJ2X2 



(Z).19) 



An observer is designed as 



^2 = A22X2 + [A21X1 + B 2 « + f {\ 

y = Cxj 

where y = — /, + x, — Ai,x, — B,u 
C = Aj2 



(£>.20) 



Redefining equation (D.19) results in 



X2 = A22X2 + A21X] + B2W + 

+ L[x, - A,,x, - B,« - A, 2 X 2 ] 

X 2 = X 2 - X 2 

X 2 = [A 22 ~ £A)2] X 2 



(D.21) 



(Z).22) 



As 't' -> 00 Xj -* 0. 

C. NUMERICAL SOLUTION 

Using the values provided in equation (D.18), the solution to equation (D.IO) is 



I si — A| = s + 0 + 0 — 0 — 0 — 0 
a I = 0 a 2 — 0 a^ ~ 0 



(Z).23) 



where 





V 




1 

0 

0 

0 


= 


0 


A^ = 


1 0 0 




0 




! 

0 
^ 0 
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From equation (D.ll) and equation (D. 12) 





'l 0 o' 




'l 0 o' 


iV = 


0 1 0 


iVlF = 


0 1 0 




_0 0 1_ 




1 

o 

o 

1 



INV(NW) 



1 0 0 
0 1 0 
0 0 1 



a — [a|, ^ 2 , 



aa] 



The coefiicients for the a, terms were selected from the ITAE criteria table for a 
third order characteristic equation. The values selected were a, = 1.75co„, 
3j = 2.15co^, aj = 1.0a>^ [Ref 8: pp. 129-130]. Equation (D. 13) now' equals 

K' = [l.75cu„ 2.15(0^ l.OOcuy 

Looking back at equation (D.21), let K = L. 

A block diagram of the observer is shown in Figure 8 and in Figure 9. 
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APPENDIX E. GRAPHS OF ADDITIONAL SIMULATIONS 



A. GRAPHS WITH NO ADDED MASS 

1. Rigid Body with no load 

The graphs for motor feedback with no damping and a load of 1.36 kg and 
o)„ = 3 are shown in Figure 51, Figure 52, and Figure 53. 

2. Flexible Body with no load 

The graphs for flexible body with no damping and a load of 1.36 kg and 
o)„ = 4 are shown in Figure 54, Figure 55, and Figure 56. 

B. GRAPHS WITH AN ADDED MASS OF 1.36 KILOGRAMS 

1. Rigid Body Model with Added Mass 

For the examination of the Rigid Body model graphs with damping and added 
mass under going point to point control see Figure 57 and Figure 58 for a>„ = 1 and 
Figure 59 and Figure 60 for = 3. 

2. Flexible Body Model with Added Mass 

For an examination of the Flexible Body Model experiencing point to point 
control and added mass see Figure 61 and Figure 62 for o)„ = 2 and Figure 63 and 
Figure 64 for co, = 4. 

C. GRAPHS WITH AN ADDED MASS OF 2.5 KILOGRAMS 
1. Rigid Body Model with Added Mass 

For the examination of the Rigid Body model graphs with damping and added 
mass undergoing point to point control see Figure 65 and Figure 66 for o)„ = 1 and 

Figure 67 and Figure 68 for co, = 3. 
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Figure 51. Rigid Body Model (motor feedback) (0J = 3 
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Figure 52. Rigid Body Model (motor feedback) (torque) = 3 
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Figure 53. Rigid Body Model (motor feedback) (small motion) co. = 3 
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Figure 54. Flexible Body Model (0,) = 4 
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Figure 55. Flexible Body Model (torque) cj, = 4 
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Figure 57. Rigid Body Model (torque) w„ = 1 
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Figure 58. Rigid Body Model (small motion) = 1 
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Figure 59. Rigid Body Model (torque) = 3 
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Figure 60. Rigid Body Model (small motion) = 3 
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Figure 61. Flexible Body Model (torque) (o, = 2 
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Figure 62. Flexible Body Model (small motion) to, = 2 
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Figure 63. Flexible Body Model (torque) =s 4 
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Figure 64. Flexible Body Model (small motion) o, = 4 
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Figure 65. Rigid Bod}’ Model (torque) to, = 1 
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Figure 66. Rigid Body Model (small motion) to, = 1 
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Figure 67, Rigid Body Model (torque) to, = 3 
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Figure 68. Rigid Bod)' Model (small motion) to, = 3 



112 



Time (seconds) 

Rigid Body (wn=3 zeta=0.01 mass- 



2. Flexible Body Model with Added Mass 

For an examination of the Flexible Body Model experiencing point to point 
control and added mass see Figure 69 and Figure 70 for o)„ = 2 and Figure 71 and 
Figure 72 for a>„ = 4. 

D. GRAPHS UNDERGOING TRAJECTORY TRACKING 

1. Rigid Body Model Experiencing Trajectory Tracking 

For the examination of the Rigid Body model graphs with and without damping 
and added mass, under going trajectoiy tracking see Figure 73 and Figure 74 for 
co„ = 1. See Figure 75 and Figure 76 for a>„ = 1 with damping and added mass. 

2. Flexible Body Model Experiencing Trajectory Tracking 

For the examination of the Flexible Body model graphs with and without 
damping and added mass, under going trajector>’ tracking see Figure 77 and Figure 78 
for = 2. See Figure 79 and Figure 80 for cu„ = 2 with damping and added mass. 
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Figure 69. Flexible Body Model (torque) = 2 
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Figure 70. Flexible Body Model (small motion) to, = 2 
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Figure 71. Flexible Body Model (torque) co. = 4 
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Figure 72. Flexible Body Model (small motion) to, = 4 



117 



Time (seconds) 

Flexible Body Model (wn=+ zeto=0.01 mass=2.5 kg) 



100 




O 

cvj 

DO 

tD 

T — 

CM 

T— 

o 

CO 

CD 

CM 

O 



a o 

CO CD 



o o o o o 

CM CN M- 



(J919UU— uo^M9u) anbjol 



CD CD O 

CD CO O 



Figure 73. Rigid Body Model (torque) = 1 (ramp) 
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Figure 74. Rigid Body Model (small molion) t/>, = I (ramp) 
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Figure 75. Rigid Body Model (torque) load to, = I (ramp) 
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Figure 76. Rigid Body Model (sniall motion) load lo, = 1 (ramp) 
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Figure 77. Flexible Body Model (torque) = 2 (ramp) 
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Flexible Body Model (wn=2 zeta=0 mass=0) ramp input 
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Figure 78. Flexible Body Model (small molion) to, = 2 (ramp) 
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Figure 79. Flexible Body Model (torque) load to, = 2 (ramp) 
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Flexible Body Model (wn=2 zeta=0.01 moss=2.5 kg) ramp input 
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Figure 80. Flexible Body Model (small molion) load ty, = 2 (ramp) 
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Flexible Body Model (wn=2 zeta=0. 31 moss=2.5 kg) ramp input 
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